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The conventional approach to ship steering is to regard the ship as a single input, 
single output system without cross-coupling or interaction between speed, yaw and roll. 
This approach has found successful application, particularly in conventional vessels 
where the amount of cross-coupling is normally slight. But, as a result of tight 
maneuvering, the modem warship suffers severe cross-coupling effects because of large 
control surfaces, high speed and low tonnage. Consequently, the adoption of a 
multivariable approach to ship steering would appear to be more suited for the design 
of a steering control system. 

This thesis describes the results of a simulation study of pre-compensator design 
to suppress the undesirable cross-coupling effects between speed, yaw and roll. 

Simulation studies using DSL and Function Minimization are the basis for 
accomplishing the design. 

Simulation results presented indicate that the adoption of a multi-input, multi- 
output approach would result in a significant improvement in the combined steering 
and stabilization problem of a warship. 
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I. INTRODUCTION 



Modern warships must be highly maneuverable to satisfy numerous operational 
requirements. However, the steering characteristics of a modern ship are nonlinear, so 
severe interaction or cross-coupling exists between the control surface inputs and the 
controlled outputs. Therefore, warship steering is a complex multivariable control 
problem. 

Interaction between roll, yaw and speed are pronounced in warships because of 
their length to beam ratio and relatively large control surfaces. However, warships 
should be able to execute high speed maneuvers while maintaining their fighting 
capability. This is generally not possible due to severe cross-coupling. 

In this thesis, the development of a pre-compensator to reduce the cross-coupiing 
effects which are present in the steering characteristics of a modern ship is introduced. 
The design method adopted by Roberts [Ref. 1] uses the Direct Nyquist Array (DMA) 
frequency response technique as defined by Rosenbrock [Ref. 2] and Fricker [Ref. 3]. 
This thesis uses the basic ship model and the results which were reported by Roberts 
which have the potential to produce improved seakeeping and ship stability. 
Emphasis in this thesis is placed on optimizing the parameters of a pre-compensator 
using Function Minimization (F.M.) via a digital computer. 

Simulation studies employed Function Minimization techniques together with the 
Dynamic Simulation Language (DSL) package. 
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II. BASIC MODEL 



The model and data used in the study is that proposed by Roberts [Ref. 1|. The 
structure of the ship model is shown in Figure 2.1 and the elements of the transfer 
function matrix, G(S), which were derived using curve fitting techniques to measured 
step and frequency response data, are given in Table 1. 



FIN 



RUDDER 



POWER 




ROLL 



YAW 



SPEED 



Figure 2.1 Multivariable Structure of a Warship Model. 

The nonlinear nature of the ship dynamics is demonstrated by the change in 
steady state gain parameters as shown in Table 2. 
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TABLE 1 






ELEMENTS OF MATRIX FOR WARSHIP MODEL (REF. I] 


G n (S) 


K n 

4S 2 + 0. 24S + 1 






G 12 (S) 


K 12 ( -8. 57S + 


1) 




53. 3S J + 17. 17S 2 + 


9. 52S + 


1 


G :2 (S) 


K 22 






S( 12S J + 32. 25S 2 + 


11. 2S + 


1) 


g 31 (S) 


K 31 ( 10S + 1) 






240S 3 + 58S 2 + 26S 


+ 1 




G 32 (S) 


K 32 

240S 2 + 34S + 1 






G 33 (S) 


K 33 

24S + 1 






g 13 (S) 


= G 2] (S) = G 23 (s) = 0 







TABLE 2 

GAIN VARIATION (REF. 1] 


Speed 
( Kts) 


K 11 


K 12 


K 22 


K 31 


K 32 


K 33 


12 


. 114 


. 18 


. 01 


. 058 


. 096 


. 1 


18 


. 18 


. 932 


. 02 


. 067 


. 146 


. 06 


26 


. 168 


. 94 


. 021 


. 068 


. 165 


. 053 
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For ease of anal} sis the system inputs and outputs are used as defined below in 
Table 3. 



TABLE 3 

MAX VALUES OF INPUT AND OUTPUT 


INPUTS 


MAX VALUE 


Fin Angle 


± 21 ' 


Rudder Angle 


±30* 


Power 


±10% 


OUTPUTS 


MAX VALUE 


Roll Angle 


±15* 


Yaw Angle 


±120'’ 


Forward Speed 


30 Kts 



Figure 2.2 and Figure 2.3 show the time responses for the ship model when we 
use 10% demands for rudder and fin at 12 kts. 

As can be seen in Figure 2.2, there are pronounced cross-coupling effects in both 
roll and speed outputs. 

In this thesis, 10% demand for rudder at 12 kts will be always used for 
convenience. 
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Figure 2.2 Step Response for Uncompensated Warship Model 

at Rudder Demand. 
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Figure 2.3 Step Response for Uncompensated Warship Model 

at Fin Demand. 
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III. PRE-COMPENSATOR DESIGN 



The aim of including a pre-compensator, K(S), is to decouple the interaction 
present in G(S), thus enabling the reduction of interaction or cross-coupling in the 
system. The action of the pre-compensator is to propagate the three input demands in 
such a way that each input affects its associated output only. 

This chapter was extracted from Roberts (Ref. 1]. 

The system configuration with the pre-compensator included is shown in Figure 
3 . 1 . 




The approach used in this study is to develop a pre-compensator, K(S), which 
totally diagonalizes the pair G(S)K(S) ( = Q(S) ). This is in effect non-interacting 
control and can result in the elements of K(S) having high order which may prove a 
problem when it comes to implementation, particularly if this is to be achieved using 
analog techniques. If necessary the complexity of the elements of K(S) can be reduced 
using standard reduction routines while maintaining diagonal dominance in G(S) K(S). 
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The diagonalizing pre-compensator was produced using the method suggested by 
Pricker [Ref. 3]. This technique produces an initial "ideal" pre-compensator K(S) which 
diagonalizes Q(S). The elements of K(S), which can be high order, are then reduced to 
a simpler form while ensuring that diagonal dominance in Q(S) is maintained. This 
involves expressing G(S) as: 



G(S) = R(S) A(S) 



(eqn 3.1) 



where R(S) is a diagonal matrix formed by extracting common row elements from G(S) 
so that A(S) contains numerator polynomial elements only. 

The decoupling pre-compensator is therefore given by: 



K(S) = A(S)' 1 



(eqn 3.2) 



However, this method is only possible if |A(s)| = 0 has all stable factors, i.e., all 
roots of the characteristic equation are in the left half plane. If this is not the case, 
then K(S) is formed from: 



K(S) = 



Adjoint A(S) 
Realization Factor 



(eqn 3.3) 



where the realization factor will contain the stable factors of |A(S)| together with other 
suitable lag elements to make K(S) physically realizable. 

The elements of the diagonal matrix R(S) and the elements of A(S) so formed are 
given in Table 4 and Table 5 respectively. As |A(S)| contains all stable factors, the 
ideal pre-compensator can be formed directly from Equation 3.2. The results of this 
operation are given in Table 6. 

It is necessary to scale the columns of K(S) to ensure that the steady-state gains 
of the diagonal elements of Q(S) remain the same as those of G(S). The elements of 
this final pre-compensator are given in Table 7. Table 8 gives the speed related gain 
variation. 

Figure 3.2 and Figure 3.3 show that the addition of the pre-compensator has 
resulted in an improvement in outputs at 12 kts. 
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TABLE 4 

ELEMENTS OF DIAGONAL MATRIX R(S) 



R n (S) 



R 22 (S) 



R 33 (S) 



1 

(S 2 + . 06S + . 25 ) ( S 2 + . 02S + .154)(8.2S + 1) 

1 

S( . 434S + 1 ) ( 6. 62S + 1 ) ( 4. 18S + 1) 

1 

(S 2 + . 199S + . 99 ) ( 10S + 1 ) ( 24S + 1) 




This "ideal" pre-compensator can be reduced to the individual elements of K(s) 
using step response data. 

After the reduction process is completed, the elements of the reduced pre- 
compensator so formed are given in Table 9. The terms K cl , K c2 , and K c3 given in 
Table 9 are the speed related compensator gain changes necessary for the pre- 
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TABLE 6 

ELEMENTS OF DIAGONALIZING PRE-COMPENSATOR 


) 


. 00649 

K,,(S) = t 5 

11 53.19S 3 + 17. 136S 2 + 9. 5S + 1 

00454( -34. 143S 3 + 2S 2 - 8. 29S +1) 

K,,(S) = t t 

u 53. 19S 3 + 17. 136S* + 9. 5S + 1 

K 2 ,( S) = . 00285 

. 00376( 10S + 1) 

31 534S 5 + 278S 4 + 182. 6S 3 + 46. 15S" + 11. 5S + 1 

. 00013( 80050S 5 + 15650S 4 + 20665S 3 + 2255S 2 + 3S + 1 

Y ( — 


32 5 3 5 2 S 0 + 3326S 5 + 2113S 4 + 646S 3 + 162S 2 - 21. 6S + 1 

. 00285 

'K„(S) = * t 

33 100S J +30S- +12S +1 

k 1 3 (S) = k 21 (S) = k 23 (S) = 0 





compensator to cope with the non-linearity of the warship model and these are the 
same as in Table 8 . 

Figure 3.4 and Figure 3.5 show that interactions between inputs and outputs 
have not been eliminated in the system's time response when we use the reduced order 
pre-compensator also. 
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TABLE 7 




FINAL ELEMENTS OF DIAGONALIZING PRE-COMPENSATOR 


K n (S) 




1 






53. 19S 3 + 17. 136S 2 + 9. 5S + 1 




K 12 (S) 




K cl ( -34. 143S 3 + 2S 2 - 8. 29S + 1) 






53.19S 3 + 17. 136S 2 + 9. 5S + 1 




k 22 ( s ) 


= 


1 




k 31 (S) 




K c2 (10S + 1) 






534S 5 + 278S 4 + 182. 6S 3 + 46. 15S 2 + H. 5S + 1 




K 32 (S) 




K c3 ( 80050S 5 + 15650S 4 + 20665S 3 + 2255S 2 +3S + 


1) 




5352S 6 + 3326S 5 + 2113S 4 + 646S 3 + 162S 2 + 21. 


6S + 1 


K 33 (S) 




1 






100S 3 +30S 2 +12S +1 




K 13 (S) 


= 


k 2 i ( s ) = K 23 (S) = 0 





TABLE 8 

PRE-COMPENSATOR GAIN VARIATION 



Speed 
( Kts) 


1 — 1 
u 


K c2 


K c3 


12 


-1. 6 


. 579 


. 0456 


18 


-5. 2 


1. 11 


-3. 02 


26 


-5. 6 


1. 274 


-4. 08 
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Figure 3.2 Step Response for Compensated Warship Model 
at Rudder Demand. 



22 



-f? 

-3 




mji 



Figure 3.3 Step Response for Compensated Warship Model 

at Fin Demand. 
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TABLE 9 

FINAL REDUCED PRE-COMPENSATOR ELEMENTS 



RK n (S) 




1 




8. 6S + 1 


RK 12 (S) 




K 0 (-34. 14S 3 + 2S 2 - 8.3S + 1) 




53. 2S 3 + 17. 13S 2 + 9. 5S + 1 


RK 22 ( S) 


= 


1 


RK 31 (S) 








14. 8S 2 + 1. 3S + 1) 


RK 32 (S) 




K c ,(2000S 2 - 2S + 1) 




130S 3 + 25S 2 + 12. 6S + 1 


rk 33 (S) 




1 




11. 4S + 1 


RK 13 (S) 




RK 2 ,(S) = RK 33 (S) = 0 
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Figure 3.4 Step Response for Compensated Warship model 
at Rudder Demand using Reduced Order Pre-compensator. 
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Figure 3.5 Step Response for Compensated Warship model 
at Fin Demand using Reduced Order Pre-compensator. 
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IV. COMPUTER SIMULATION 



From the results discussed so far {all of which are from Roberts but were 
repeated at N.P.S. as part of this thesis), it can be seen that the pre-compensator 
substantially reduces the interaction intensity of the compensated system and results in 
improved ship stability and minimal loss of speed while executing normal maneuvers. 
Also, it has been shown that the outputs of ship's roll angle, heading angie and speed 
can be controlled by a low-order pre-compensator. However, it can also be seen that 
large cross-coupling effects exist which cause long settling times. Therefore, a method 
must still be devised which controls the interactions between inputs and outputs and 
shortens settling time. The outputs of ship's roll angle, heading angle and speed can be 
changed by a few factors. 

First of ail, this thesis will introduce the philosophy of Function Minimization 
(F.M.), which is the main theme of this paper and introduce a few factors, which have 
important effects on outputs. 

Next, using above factors, this thesis will design other pre-compensators and 
simulate them. 

A. PHILOSOPHY OF FUNCTION MINIMIZATION 

Classical control theory has historically been applied to the design problem with 
the assistance of graphical presentations and trial and error methods. Such methods 
have been quite successful in the development of good control systems, but do not 
answer the question "Is this the best system possible?". 

If a given function has a minimum within the range of permitted parameter 
variation, there exist numerical methods which can be used to find the minimum. 
These numerical methods have been programmed and most computer libraries contain 
one or more subroutines which can be used for Function Minimization. This thesis 
uses the HOOKE [Ref. 4] subroutine of DSL. 

Since one has the freedom to select the cost function to be used, certainly any of 
those used within optimal control theory can be chosen. We can therefore design an 
"optimal controller" without using the conventional theoretical approach. 

We can also use any of the well known performance indices as a cost function, 
i.e., JE 2 dt, jjE| dt, J|E|t dt are easily evaluated and minimized. 
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In addition, one can select the cost function to suit the particular specification of 
the problem. 

Figure 4.1 shows the block diagram for simulation using Function Minimization. 




B. CHOICE OF COMPENSATORS 

Use of Function Minimization in the computer is relatively expensive, so some 
preliminary analysis and design is desirable to avoid excessive computer time. For a 
simple system ( one output ) a BODE design or a ROOT LOCUS design might be a 
good starting point. The compensator thus found is then simulated and improved 
through use of Function Minimization. For the ship problem in this thesis, the 
preliminary work was done by Roberts as can be seen in Chapters II and III. 
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This thesis uses Roberts' compensators and outputs as a starting point. The 
desired output curves were obtained by modifying the known outputs. The questions 
to be answered are: 

• Can better performance be obtained using the original compensator but 
requiring a better output? 

• Can the compensator be reduced and the resulting output be as good or better 
than the original compensators? 

• Can a better output be obtained by increasing the order of the compensator? 

When the Function Minimization subroutine minimizes the function, it moves 

the poles and zeroes of the compensator to the best locations in the S-plane. If the 
compensator has too many poles and zeroes, the program tends to set Z = P for the 
unneeded poles and zeroes, thus the compensator order may be reduced. 

In many cases, even though the poles and zeroes may not exactly cancel, they are 
placed so close to each other that they contribute very little to the result and so we 
may efficiently cancel them. Thus one can start the design by simply choosing each K c 
to have numerous zeroes and poles as can be seen in Table 7 and Figure 3.2, which is 
the original pre-compensator. However, this thesis will show us that we don't need 
that many poles and zeroes for the choice of compensators. 

In this thesis, as shown in Table 9 and Figure 3.4, the reduced order pre- 
compensator was used. 

The optimum parameter values of this reduced order pre-compensator, which 
reduces the corresponding cross-coupling, can be determined by Function 
Minimization and Table 10 shows the optimum parameter values of the reduced order 
pre-compensator in Table 9 by Function Minimization. 

Figure 4.2 shows the positive damping effect on the system's time response when 
optimum parameter values are used in the reduced pre-compensator. 

Figures 4.3 through Figure 4.5 show the difference between Roberts' method and 
the Function Minimization method, where the continuous line is the output of Roberts 
and the dotted line is the output of Function Minimization. 

As shown in Figure 4.4 and Figure 4.5, cross-coupling is decreased dramatically 
in the case of Function Minimization. 

C, CHOICE OF DESIRED OUTPUTS 

One can always choose the ideal output as the desired output for the Function 
Minimization subroutine. However, this may not be a good choice because that 
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TABLE 10 


OPTIMUM PARAMETER VALUES OF REDUCED PRE- 
COMPENSATOR 


RK U (S) = 


1 


8. 6S + 1 


rk 12 (S) = 


K c2 (-72.14S 3 + 1.98925S 2 - 2. 3S + 1) 


76. 2S 3 + 28. 63S 2 + 11. 5S + 1 


RK 22 (S) = 


1 


rk 31 (s) = 


. 63525 


32. 05S 2 + 2. 975S + 1 

K c3 ( 1741. 25S 2 - 1.94375S + 1) 


RK 32 (S) = 


9.25S 3 + 111.25S 2 + 47. IS + 1 


RK 33 (S) = 


1 


11. 4S + 1 


RK 13 (S) = 


RK 21 (S) = RK 33 (S) = 0 



particular output may be impossible to achieve. Although the minimization process 
will determine a closest fit, if the cost function is a "least squares" function the 
solution may not be acceptable. For example, with the ship problem of this thesis, the 
ideal output might be 

• Turn radius of two ship lengths 

• • Zero speed change 

• Zero roll angle 

None of these characteristics are possible. The results of a Function 
Minimization design will not satisfy any of them and the design achieved may not be 
acceptable. The desired output must therefore be chosen realistically, i.e., within the 
physical capabilities of the system. For the ship control problem, outputs were chosen 
based upon the results obtained by Roberts. In order to obtain better performance the 
desired outputs were chosen to be similar. 
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Figure 4.2 Output when we use the Optimum values of Reduced Pre-compensator 

at Rudder Demand. 
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Figure 4.3 Comparison between Roberts and F.M at Yaw output. 
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Figure 4.4 Comparison between Roberts and F.M at Roll output. 
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Figure 4.5 Comparison between Roberts and F.M at Speed output. 
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This thesis chose 3 desired system outputs , each consisting of a specification for 
heading, roll and speed. These desired output curves (AFGEN1, 2 and 3) were 
obtained by modifying the known outputs (Figure 3.3) using Arbitrary Function 
Generators (AFGEN) provided by DSL. 

Figure 4.6, Figure 4.7 and Figure 4.8 show AFGEN 1, AFGEN2 and AFGEN3 
respectively. 

We can know that the AFGEN3 is better than the other wo cases by the trial 
and error method. Therefore this thesis will use the AFGEN3 for desired outputs for 
another simulation. 

D. COST FUNCTIONS 

When using Function Minimization as a design tool, a cost function must be 
chosen. This cost function is usually an integral. 

One possible procedure is to choose the desired performance as a reference and 
select a cost function which is the integral of the square of the difference between 
desired output and actual output. When the system has several outputs, the cost 
function must consider all of them, usually as a weighted sum. 

E. WEIGHTING FACTORS 

For the three outputs system, the cost function is of the form 

E = XjEj 2 dt + XjE 2 2 dt + X 3 jE 3 2 dt. 

There are no fixed rules for choosing the values factors Xj, X 2 and X3. One 
approach is as follows: 

• Select the output which is considered most important, say # 1. Use this as a 
• reference and select Xj = 1.0. 

• Base the value assigned to the second weighting factor, X, in this case, on the 

importance of output ?? 2 with respect to output # 1. If output # 2 is equally 
important as output # 1, then X 2 = 1.0. If it is half as important, then X 2 = 
.5. 

• The third weighting factor is chosen in like manner. If the third output is less 

important than the first, then X3 < X 1 . If it is also less important than the 

second output, then X3 < X 2 . 

The actual numbers chosen, for example X 2 = 0.1, are simply estimates based on 
experience. The designer may decide to change them after studying simulation results 
of a first design. 

In the case of ship control, the primary output is heading. Therefore, assign X h a 
value of 1.0. Some change in speed is unavoidable and the desired response should 
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Figure 4.6 AFGEN 1. 
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Figure 4.7 AFGEN 2. 
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Figure 4.8 AFGEN 3. 
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show this. However, if the desired response cannot be achieved perhaps more 
fluctuation in speed would be acceptable. For example, a value of approximately 0.1 
could be assigned to X s . If the desired roll output is twice as important as the speed 
output, then would be assigned a value of 0.2. 

Table 11 shows each case for simulation using weighting factors. 



TABLE 11 

SIMULATION CASES USING WEIGHTING FACTORS(W.F.) 


CASE 


K 


X r 




OUTPUTS 


1 


1 


. 2 


. 1 


Figure 4. 9 


2 


1 


. s 


. 1 


' 

Figure 4. 10 


3 


1 


. 6 


. 4 


Figure 4. 11 


4 


1 


1 


1 


Figure 4. 12 



CASE4 is from Table 10, which uses X h = 1, = 1 and X s = 1 and this was 

repeated in Table 11 for comparison when we consider the weighting factors. 

Table 12 through Table 15 show the elements of the resulting compensators for 
each of the above when we used the F.M. approach. 

When F.M. was used for all coefficients in compensators, RK 12 , RK 31 and RK 32 
were the parameters that the F.M. subroutine adjusted. 
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Figure 4.9 Step Response when = 1 , X f = .2 and X s = . 1 
at Rudder Demand. 
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Figure 4. 10 Step Response when X h = 1 , = .6 and X s = . 1 

at Rudder Demand. 
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Figure 4. 1 1 Step Response when X, ( = 1 , X f = .6 and X $ = .4 
at Rudder Demand. 
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Figure 4.12 Step Response when X h = 1, X f = 1 and X s = 1 
at Rudder Demand. 
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TABLE 12 




OPTIMUM PARAMETER VALUES OF REDUCED PRE- 
COMPENSATOR AT CASE 1 W.F. 


RK n (S) 


1 

8. 6S + 1 




rk 12 ( S) 


K r ,( -47. 64S 3 + 2.0C0625S 2 - 2 


. 3S + 1) 


67. 7S 3 + 27.38S 2 + 11. 375S + 


1 


RK 22 ( S) 


= 1 




RK 31 ( S) 


. 577125 

20. 425S 2 + 1. 8625S + 1 




RK 32 (S) 


K o1 ( 1915. 625S 2 - 2 . 001875S + 


1) 


90. 625S 3 + 53. 125S 2 + 23.85S 


+ 1 


RK 33 (S) 


1 . 

11. 4S + 1 




RK 13 (S) 


= RK 21 (S) = RK 33 (S) = 0 
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TABLE 13 

OPTIMUM PARAMETER VALUES OF REDUCED PRE- 
COMPENSATOR AT CASE 2 W.F. 



RK n (S) 

RK I2 (S) 



1 

8. 6S + 1 

K c ,(-66.14S 3 + 1.99525S 2 - 3. 3S + 1) 
45. 2S 3 + 31. 13S 2 + 10. 5S + 1 



RK 22 (S) 

RK 31 (S) 

RK 32 ( S ) 

RK 33 (S) 

rk 13 (S) 



1 

. 603999 

25. 8S 2 + 2. 4S + 1 
K c3 ( 1835S 2 - 1.975S + 1) 
53 S 3 + 80S 2 + 34. 6S + 1 
1 

11. 4S + 1 

rk 21 (S) = RK 33 (S) = 0 
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TABLE 14 

OPTIMUM PARAMETER VALUES OF REDUCED PRE- 
COMPENSATOR AT CASE 3 W.F. 



RK n (S) 




1 




8. 6S + 1 


RK l2 ( S) 




K,(-56. 14S J + 1.996S 2 - 2. 3S + 

c l v 




71. 2S-' + 27. 13S 2 + 11.25S + 1 


rk 22 (S) 


= 


1 


rk 31 (S) 




. 6015 




25. 3S 2 + 2. 35S + 1 


rk 32 (S) 




K c ,( 1842. 5S 2 - 1. 9775S + 1) 




56. 5S J + 77. 5S 2 + 33. 6S + 1 


RK 33 (S) 




1 




11. 4S + 1 


rk 13 (S) 




rk 21 (S) = RK 33 (S) = 0 
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TABLE 15 

OPTIMUM PARAMETER VALUES OF REDUCED PRE- 
COMPENSATOR AT CASE 4 W.F. 



RK n (S) 




1 




8. 6S + 1 


RK 12 (S) 




K c2 (-72.14S 3 + 1.98925S 2 - 2. 3S 




76. 2S 3 + 28. 63S 2 + 11. 5S + 1 


RK 22 ( S ) 


= 


1 


rk 31 (S) 




. 63525 




32. 05S 2 + 2. 975S + 1 


RK 32 ( S ) 




K c3 ( 1741. 25S 2 - 1.94375S + 1) 




9.25S 3 + 111.25S 2 + 47. IS + 1 


RK 33 (S) 




1 




11. 4S + 1 


rk 13 (S) 




RK 21 (S) = RK 33 (S) = 0 



From simulation, it appears that the. most desirable output can be obtained at - 
K = 1 = -2andX s = .1. 

Figure 4.13 through Figure 4.15 show the comparison between the Figure 3.4 for 
Roberts, Figure 4.2 for CASE 4 and Figure 4.9 for CASE l. Where the output of 
Roberts is from Table 9, which gives the final reduced pre-compensator elements, the 
output of CASE 4 is from Table 10, which gives the optimum parameter values of 
reduced order pre-compensator by Function Minmization. The output of CASE 1 is 
the best case when we consider the weighting parameters for CASE 1, 2 and 3 in Table 
11 . 

The continuous line is used for Roberts, the dotted line for CASE 4 and the 
dashed line for CASE 1 outputs. 

Figure 4.16 through Figure 4.18 show the comparison between the above three 
cases for Fin, Rudder and Power respectively. 
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Figure 4.13 Comparison between Fig 3.4, Fig 4.2 and Fig 4.9 

at Yaw Output. 
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Figure 4.14 Comparison between Fig 3.4, Fig 4.2 and Fig 4.9 

at Roll Output. 



49 




Figure 4.15 Comparison between Fig 3.4, Fig 4.2 and Fig 4.9 

at Speed Output. 
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Figure 4.16 Comparison between Roberts, CASE 4 and CASE 1 
for Fin Output at 3° Rudder Demand. 
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Figure 4.17 Comparison between Roberts, CASE 4 and CASE 1 
for Rudder Output at 3° Rudder Demand. 
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Figure 4.18 Comparison between Roberts, CASE 4 and CASE 1 
for Power Output at 3° Rudder Demand. 
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The simulation obtained so far was performed using three degrees for rudder 
demand and we can know that there is no problem about maximum values of input 
and output shown by Table 3 for each output. 

As can be seen in Figure 4.16 through Figure 4.18, CASE 1 is better than the 
other two cases. But we have to consider, carefully the physical realization in Figure 
4. IS because the power curve varies very fast. Therefore when we design the pre- 
compensator using weighting factors or other factors, we have to always consider 
physical realization limitations. 

Figure 4T9 through Figure 4.21 show the comparison between the above three 
cases for Fin, Rudder and Power when we use twenty degrees for rudder demand. 

From the above outputs, we can see that CASE 4 is better than the other two 
cases when We use twenty degrees for rudder demand. 

F. VARIATION OF NUMBER OF POLES AND ZEROES 

As shown by Table 7, the original pre-compensator by Roberts requires complex 
mathematical equations for a complete and detailed description. For many problems 
in the analysis and design of many modem dynamic systems, a simplified description, 
i.e., a low order model, is adequate and desirable. This thesis is concerned with the 
development of such low order models for the pre-compensator. 

Two types of situations are commonly encountered in practice: 

• A system exists and can be tested, but its equations are not well known or not 
clearly defmed. 

• A high order complex model of the system is known and can be used, but 

it is undesirable for the problem to be studied. 

In either case the response of the system to a chosen signal can be obtained, and 
a low order model developed which has essentially identical outputs for identical inputs 
as the higher model. 

By carefully planned studies it should be possible to see how much reduction in 
order can be achieved, how closely the behavior of the. low order compares to that of 
the system and perhaps a best or optimum order can be found for the reduced order 
models. 

In addition, by careful selection and classification of the pole-zero geometry of 
the high order system, it is hoped that a correlation may be found between such 
geometry and that of the best low order model. In any event, it is anticipated that 
some rules may be established for the choice of the number of poles and zeroes in the 
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Figure 4.19 Comparison between Roberts, CASE 4 and CASE 1 
for Fin Output at 20° Rudder Demand. 
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Figure 4.20 Comparison between Roberts, CASE 4 and CASE l 
for Rudder Output at 20° Rudder Demand. 
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Figure 4.21 Comparison between Roberts, CASE 4 and CASE 1 
for Rower Output at 20° Rudder Demand. 
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low order model, such that evaluation of the pole, zero and gain will require only a few 
computer runs. 

As shown in Figure A.l of System Block Diagram for Simulation, Kjj and K, 2 
affect the Fin output of the system and K 31 , K 32 and K 33 affect the Power output of 
the system. Therefore when we change the order of these elements, outputs, i.e., roll 
and speed will be changed by them also. 

Unfortunately there is no known mathematical basis for choosing the "best" 
order for a low order model for each element of the pre-compensator. For 
convenience, this thesis has changed the order of and K 33 for two cases only. 

Table 16 and Table 17 show the values of element for two cases and Figure 22 
through Figure 25 show the outputs for comparison between original reduced order 
pre-compensator by Table 10 and the above two cases respectively. Other elements are 
the same as in Table 10. 







TABLE 16 


OPTIMUM PARAMETER VALUES OF REDUCED PRE- 






COMPENSATOR 






WHEN WE CHANGE K u ONLY 


K U (S) 




97. 18759S + 3. 94875 




7.53125S 2 + 21. 075S + 12.025 


K 12 (S) 




K c2 (-72.14S 3 + 1.98925S 2 - 2. 3S + 1) 




76. 2S 3 + 28. 63S 2 + 11. 5S + 1 


K 22< S > 




1 


k 31 (S) 




. 63525 




32. 05S 2 + 2. 975S + 1 


k 32 ( S ) 




K c3 ( 1741. 25S 2 - 1. 94375S + 1) 




9.25S 3 + 111.25S 2 + 47. IS + 1 


K 33 (S) 




1 




11. 4S + 1 


K 13 (S) 


= 


K 2i ( s ) = K 33 (S) = 0 
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TABLE 17 


OPTIMUM PARAMETER VALUES OF REDUCED PRE- 






COMPENSATOR 


WHEN WE CHANGE K 33 AGAIN IN TABLE 16 


K n (S) 




97. 18759S + 3. 94875 




7.53125S 2 + 21.075S + 12.025 


K 12 (S) 




K c2 (-72.14S 3 + 1. 98925S 2 - 2. 3S + 1) 




76. 2S 3 + 28.63S 2 + 11. 5S + 1 


k 22 ( S ) 


= 


1 


K 31 (S) 




. 63525 




32. 05S 2 + 2. 975S + 1 


k 32 ( s ) 




K c3 ( 1741. 25S 2 - 1. 94375S + 1) 




9.25S 3 + 111.25S 2 + 47. IS + 1 


k 33 (S) 




98. 1875S + 2. 05625 




6. 65625S 2 + 28. 05625S + 4.43625 


k 13 (S) 




K 21 (S) = K 33 (S) = 0 



By the same algorithm, we can approach the appropriate order of pre- 
compensator and the values of each element for better design. 

As can be seen in Figure 4.22 through Figure 4.25, when we put the additional 
zero and pole to the element of the pre-compensator, the cross-coupling of the roll 
output is decreased dramatically. 
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Figure 4.22 Comparison between Table 10 and Table 16 
for Roll Output. 
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Figure 4.23 Comparison between Table 10 and Table 16 
for Speed Output. 
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Figure 4.24 Comparison between Table 10 and Table 17 
for Roll Output. 
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Figure 4.25 Comparison between Table 10 and Table 17 
lor Speed Output. 
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V. CONCLUSIONS AND RECOMMENDATIONS 



A. CONCLUSIONS 

In this thesis, the development of a pre-compensator to reduce the undesired and 
highly nonlinear cross-coupling effects in the maneuvering characteristics of a modem 
warship has been presented. Simulation results have shown that Function 
Minimization procedures for coordinated steering of a surface ship would significantly 
improve ship stability, minimize loss of speed and reduce the interaction intensity of 
the compensated system. 

Simulation results have also shown that the reduced pre-compensator can be 
determined by Function Minimization directly from an ideal pre-compensator based on 
given specifications. 

B. RECOMMENDATIONS 

Computer simulation for Function Minimization leads to the following 
recommendations: 

• This thesis uses the "HOOKE" subroutine of DSL for Function Minimization. 
It has certain constraint parameters, i.e., ITMAX, CFT. Simulation outputs 
are changed by changing initial values and the step size for Function 
Minimization. Therefore, for given specifications initial values and step size for 
Function Minimization by constraint parameters should be determined by 
experience. 

• In this thesis, it has been shown that Function Minimization can be used for 
various cases as shown in Table 11. A particular case for needed specification 
should be determined and simulated by trial and error method for element 
optimum values which have undesired cross-coupling effects. 

• In this thesis, it has been assumed that the stabilizer fin to yaw cross-coupling 
term, G-^S), is a null entry for the class of warship considered. However, it is 
recommended that cross-coupling between these parameters be considered in 
further studies on general surface ships. 

• Further research should investigate ship characteristic constraints. 

• Further research should investigate the effects of various sea state conditions, 
speeds and maneuvering. 
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APPENDIX A 

SYSTEM BLOCK DIAGRAM FOR SIMULATION 
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APPENDIX B 

CONSTRAINT PARAMETERS OF FUNCTION MINIMIZATION 

To use HOOKE, the user must initialize the following arguments and, in the 
main program, 

CALL HOOKE (X, STEP, N, ITMAX, CFTOL, ALPHA, BETA, CF, Q, QQ, 
W, IPRINT, MINMAX) 

All of these arguments must be initialized in MAIN, except for X, CF, Q, QQ, 
and W. Recommended values for ALPHA and BETA are ALPHA = 2., BETA = 0.5. 
All of the arrays, i.e., X, STEP, Q, QQ and W, must be declared and dimensioned in 
MAIN. 
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TABLE 18 

THE LIST OF PARAMETERS 


ARGUMENT 


MEANING 


X 


the array of N parameter values. The user must 
supply the initial guesses, either in the DSL 
program or in MAIN. 


STEP 


an array of dimension N containing the initial 
stepsizes to be used in the search. 


N 


the number of parameters ( a positive integer, 
at most 15). 


ITMAX 


1 

the maximum number of function calls to be 
performed. 


CFTOL 


the error in the criterion function to be 
reached before the program terminates 
(difference between the current value and the 
previous stage value). 


ALPHA 


the factor of (Y - X) which is added to Y to get 
XNEW; a number greater than or equal to 1. 


BETA 


the stepsize reduction factor; a number between 
0 . and 1 . 


CF 


the value of the criterion function. 


Q / QQ / w 


arrays of dimension N, to be used as work space. 
Thev must be declared and dimensioned in the 
MAIN program. 


IPRINT 


an integer f lag: = 0 for no intermediate printout 

= 1 for intermediate printout 

of X, CF, the number of function evaluation and 
notification of step-reduction. 


M INMAX 


an integer f lag: = -1 searches for a minimum 

= +1 searches for a maximum 
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APPENDIX C 

COMPUTER PROGRAM FOR UNCOMPENSATED SYSTEM 

TITLE SIMULATION OF UNCOMPENSATED SYSTEM 
ARRAY A1(1),B1(3),A2(2),B2(4),A3(1),B3(5),A4(2),B4(4),... 

A5( 1),B5(3),A6( 1),B6(2) 

TABLE Al(l) = 1, B 1( 1-3) = 4, . 24, 1, A2( 1-2) = -8. 57,1, B2( 1-4) = 53.3,17.17,... 

9.52,1,A3(1)= l,B3(l-5)= 12,32.25,1 1.2, l,0,A4(l-2)= 10,1,... 

B4(l-4)= 240,58,26, 1,A5(1)= l,B5(l-3) = 240, 34,1, A6(l)= 1,... 

36(1-2)= 24,1 

CONST K 1 1 = 0. 1 14, K 1 2 = 0. 1 8,K22 = .01 ,K3 1 = 0.058, K32 = 0.096, K33 = 0.1,... 

RL = 0.,YW=0.,SP = 0. 

DERIVATIVE 

FIN = 0.0*STEP(0) 

RUDDER = 3.*STEP(0) 

POWER = 0. >: -STEP(0) 

ROLL1 = TRNFR(0,2.RL,AI,B1,K11*FIN) 

ROLL2 = TRNFR(l,3,RL,A2.B2.K12*RUDDER) 

ROLL = ROLL 1 -r ROLL2 

YAW= TRNFR(0,4,YW,A3,B3,K22*RUDDER) 

SPEED1 = TRNFR(1,3,SP,A4,B4,K3PFIN) 

SPEED2= TRNFR(0,2,SP,A5,B5,K 32* RUDDER) 

SPEED3= TRNFR(0,1,SP,A6,B6,K33*POWER) 

SPEED = -SPEED 1 -SPEED2 + SPEED3 
CONTROL FINTIM = 80. 

*RINT 1., ROLL, YAW, SPEED 
SAVE (SI) 0.1, ROLL, YAW, SPEED 

GRAPH(G1/S1,DE = TEK618,PO= 0,.5) TIME(LE= 8.,UN= SEC) ROLL(LO=-l,LI=l,... 
SC= .25, NI = 8),YAW(LO = -1,LI = 3, SC = ,25,NI = 8),... 

SPEED(LO= -1,LI = 4,SC = .25, NI = 8) 

LABEL(G1)STEP RESPONSE FOR UNCOMPENSATED WARSHIP MODEL AT 12 KTS 

LABEL(G1)10 % RUDDER DEMAND 

END 

STOP 
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APPENDIX D 

COMPUTER PROGRAM FOR ORIGINAL PRE-COMPENSATOR 

TITLE SIMULATION OF ORIGINAL PRE-COMPENSATOR 
ARRAY A1(1),B1(3),A2(2),B2(4),A3(1),B3(5),A4(2),B4(4),... 
A5(1),B5(3),A6(1),B6(2) 

ARRAY C 1( 1),D 1(4),C2(4),D2(4),C3(2),D3(6),C4(6),D4(7),C5(1),D5(4) 

TABLE Al(l) = l,Bl(l-3) = 4,.24,l,A2(l-2) = -8.57, l,B2(l-4)= 53.3,17.17,... 
9.52,1,A3(1)= 1 ,B3( 1-5) = 12,32.25,1 1.2, 1,0, A4(l-2)= 10,1,... 

B4( 1 -4 ) = 240,58,26, 1 ,A5( 1 ) = 1 ,B5( 1 -3) = 240,34, 1 ,A6( 1 ) = 1 ,. . . 

B6( 1-2) =24.1 

TABLE Cl(l)= 1,D 1(1-4) = 53. 19, 17. 136,9.5,1,... 

C2(l-4)= -34.143,2,-8.29,1,... 

D2(l-4) = 53.19,17.13,9.5,l,C3(l-2)= 10,1,... 

D3( 1-6) = 534,278.182.6,46.15,1 1.5,1,... 

C4( 1-6) =80050,15650,20665.2255.3,1,... 

D4( 1-7) = 5352, 3326.21 13,646, 162,21. 6,1,... 

C5(l)= l,D5(l-4)= 100,30,12,1 

CONST Kll =0.1 14, K 12 = 0. 18,K22 = .01, K3 1 = 0.058, K32 = 0.096, K33 = 0.1,... 

RL = 0.,YW = 0.,SP = 0. 

CONST GC 10 = 0,GC20 = 0,GC30 = 0,GC40 = 0,GC50 = 0 
DERIVATIVE 

RIN = 0.0*STEP(0) 

YIN= 3.*STEP(0) 

SIN = 0.*STEP(0) 

El = RIN-ROLL 
E2 = YIN-YAW 
E3 = SIN-SPEED 

FIN1 = TRNFR(0,3,GC10,C1,D1,E1) 

FIN2 = TRNFR(3,3,GC20,C2,D2,-1.6*E2) 

FIN = FIN 1 + FIN2 

ROLL1 = TRNFR(0,2,RL,A1,B1,K11*FIN) 

RUDDER = YIN- YAW 

ROLL2=TRNFR(l,3,RL,A2,B2,K12*RUDDER) 

ROLL= ROLL1 + ROLL2 

YAW = TRNFR(0,4,YW,A3,B3,K22*RUDDER) 

SP1 = TRNFR(l,5,GC30,C3,D3,0.579*El) 
SP2=TRNFR(5,6,GC40,C4,D4,0.0456^E2) 

SP3 = TRNFR(0,3,GC50,C5,D5,E3) 

SPEED 1 = TRNFR(1,3,SP,A4,B4,K31” , FIN) 

SPEED2 = TRNFR(0,2,SP,A5,B5,K32 !|! RUDDER) 

POWER= SP3-SP2-SP1 

SPEED3 = TRNFR(0,1,SP,A6,B6,K33*POWER) 

SPEED = SPEED3-SPEED2-SPEED 1 
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CONTROL FINTIM = 80. 

*RINT L, ROLL, YAW, SPEED 
SAVE (SI) 0.1, ROLL, YAW, SPEED 

GRAPH(G1/S1,DE = TEK618,PO = 0,.5) TIME(LE = 8., UN- SEC) ROLL(LO= -2, LI - 1,... 
SC = .5,NI = 8),YAW(LO = -2, LI = 3, SC = .5,NI = 8),... 

SPEED(LO = -2, LI = 4, SC = .5,NI = 8) 

LABEL(G1)STEP RESPONSE FOR COMPENSATED WARSHIP MODEL AT 12 KTS 

LABEL(G1)10 % RUDDER DEMAND 

END 

STOP 
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APPENDIX E 

COMPUTER PROGRAM FOR ORIGINAL REDUCED PRE- 
COMPENSATOR 

TITLE SIMULATION FOR ORIGINAL REDUCED ORDER PRE-COMPENSATOR 
ARRAY Al(l),Bl(3),A2(2),B2(4),A3(l),B3(5),A4(2),B4(4),... 

A5(l),B5(3),A6(l),B6(2) 

ARRAY C 1( 1),D l(2),C2(4) t D2(4),C3( 1),D3(3),C4(3),D4(4),C5( 1),D5(2) 

TABLE Al(l)= 131(1-3) = 4,. 24, 1,A2( 1-2) = -8.57, 132(1-4)= 53.3, 17. 17,... 

9.52,1,A3(1) = l,B3(l-5)= 12,32.25.1 1.2, 1,0, A4( 1-2)= 10,1,... 

B4( 1-4) = 240,58,26, 1 ,A5( 1) = 1 ,B5( 1 -3) = 240,34, 1 ,A6( 1) = 1 ,... 

B6( 1-2) = 24,1 

TABLE Cl(l)= 1, Dl( 1-2) = 8.6, 1,C2( 1-4) = -34.14,2,-8.3,1,... 

D2( 1-4) = 53. 2,17.13, 9.5,1, C3(l) = l.D3(l-3)= 14.8,1.3,1,... 

C4( 1-3) = 2000,-2, 1, D4( 1-4) = 1 30.25, 12.6, 1 ,... 

C5(l)= l,D5(l-2)= 11.4,1 

CONST K1 1 = 0. 114, K12 = 0. 18, K22 = . 01, K3 1 = 0.058, K32 = 0.096.K33 = 0.1,... 

RL = 0.,YW = 0.,SP = 0. 

CONST KC1 = - 1.6.KC2 = 0.579, KC3 = 0.0456,... 

GC 10 = 0,GC20 = 0,GC30 = 0,GC40 = 0,GC50 = 0 
DERIVATIVE 

RIN = 0.0*STEP(0) 

YIN=3.*STEP(0) 

SIN = 0.*STEP(0) 

El = RIN-ROLL 
E2= YIN-YAW 
E3 = SIN-SPEED 

FIN1 = TRNFR(0,1,GC10,C1,D1,E1) 

FIN2 = TRNFR(3,3,GC20,C2,D2,KC1*E2) 

FIN= FIN1 + FIN2 

ROLL1 = TRNFR(0,2,RL,A1,B1,K11*FIN) 

RUDDER* YIN-YAW 

ROLL2 = TRNFR( l,3,RL,A2,B2,K12 !i! RUDDER) 

ROLL = ROLL 1 + ROLL2 

YAW = TRNFR(0,4,YW,A3,B3,K22*RUDDER) 

SP1 = TRNFR(0,2,GC30,C3,D3,KC2*E1) 

SP2 = TRNFR(2,3,GC40,C4,D4,KC3*E2) 

SP3 = TRNFR(0,1,GC50,C5,D5,E3) 

SPEED 1 = TRNFR( 1,3,SP,A4,B4,K31*FIN) 

SPEED2 = TRNFR(0,2,SP,A5,B5,K32*RUDDER) 

POWER =SP3-SP2-SP1 

SPEED3 = TRNFR(0,1,SP,A6,B6,K33*POWER) 

SPEED = SPEED3-SPEED2-SPEED1 
CONTROL FINTIM = 80. 
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*RINT 1., ROLL, YAW, SPEED 
*RINT L, FIN, RUDDER, POWER 
SAVE (SI) 0.1, ROLL, YAW, SPEED 

GRAPH(G1/S1,DE = TEK618,PO = 0,.5) TIME(LE = 8., UN = SEC) ROLL(LO= -2, LI = 1,... 
SC = .5,NI = 8),YAW(LO = -2, LI = 3, SC = .5,NI = 8),... 

SPEED(LO = -2, LI = 4, SC = .5,NI = 8) 

LABEL(Gl)STEP RESPONSE FOR COMPENSATED WARSHIP MODEL AT 12 KTS 

LABEL(G1)FIGURE 3.4 

END 

STOP 
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APPENDIX F 

COMPUTER PROGRAM FOR AFGEN SUBROUTINE 



TITLE SIMULATION FOR desired outputs using afgen subroutine 
AFGEN RL = 0,0,1, -.03 ,4, -.1,10,0, 16,0, 23, 0,29, 0,36,0,... 

42,0,48,0,54,0,61,0,67,0,30,0 

AFGEN YW = 0,0,1, .00006, 4, .006, 8, .04, 10, .07, 20, .29, 30, .55, 40, .8, 80, 1.61 
AFGEN SD = 0,0,1, -.004, 10, -.01, 21, 0,31, 0,41, 0,51, 0,70, 0,80,0 
DERIVATIVE 

X = TIME 

ROLL = NLFGEN(RL.X) 

YAW = NLFGEN(YW,X) 

SPEED = NLFGEN(SD,X) 

CONTROL FINTIM = 80 
'RINT 1., ROLL, YAW, SPEED 
SAVE (SI) O.l.ROLL, YAW, SPEED 

GRAPH(G1/S1,DE = TEK618,PO = 0,.5) TIME(LE= 8.,UN= SEC),ROLL(LO = -2, LI 
SC = ,5,NI = 8),YAW(LO = -2, LI = 3, SC = .5,NI = 8),... 

SPEED( LO = -2, LI = 4, SC = .5,NI = 8) 

LABEL(Gl) AFGN 1 FOR FIGURE 4.6 

END 

STOP 
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APPENDIX G 

COMPUTER PROGRAM FOR FUNCTION MINIMIZATION 

D COMMON/HANDJ/FLAG,ER,Kl l K2,K3,K4,K5,K6,K7 f K8,K9,K 10,K 1 1 ,K 12 

D COMMON/HANDJ/K13.K14 

TITLE SIMULATION FOR FUNCTION MINIMIZATION SUBROUTINE 
ARRAY A1(1),B1(3),A2(2),B2(4),A3(1),B3(5),A4(2),B4(4),A5(1),B5(3),... 

A6(1),B6(2) 

STORAG Cl( 1),D1(2),C2(4),D2(4),C3(1),D3(3),C4(3),D4(4),C5(1),D5(2) 

TABLE A 1(1)= l.Bl(l-3) = 4,.24,l,A2(l-2) = -8.57,l,B2(l-4) = 53.3,17.17,... 

9.52,1,A3(1) = l,B3(l-5)= 12, 32.25. 11.2, l,0,A4(l-2) = 10,1,... 

B4(l-4) = 240,58,26,1,A5(1) = l,B5(l-3) = 240,34,1,... 

A6(l)= l,B6(l-2)= 24,1 

CONST KOI = -34.14,K20 = 2,K30= -8.3,K40= 53.2, K50 = 17.13, K60 = 9.5, K70= .579,... 

K80= 14.8,K90= 1.3,K100= 2000, K1 10 = -2,K120= 130,K130= 25,... 

K140= 12.6 

CONST Cl 1 = .114,02 = .18, C22 = .01, C31 = .058,032 = .096, C33 = .1,IC = 0,... 

KC1 = -1.6.KC3 = 0.0456 

PARAM K 1 MIN = -50, K 1 MAX = 200,K2MIN = .01 ,K2MAX = 200,K3MIN = - 10,K3MAX = 200, 
K4MIN= .01,K4MAX = 200,K5MIN= .01,K5MAX = 200,K6MIN= .01,K6MAX = 200,.. 
K7MIN = .01,K7MAX = 200,K8MIN = .01,K8MAX = 200,K9MIN = .01,K9MAX = 200,.. 
K10MIN=.01,K10MAX= 3000,K11MIN=-10,K11MAX = 200,K12MIN=.01,... 
K12MAX= 200, K 13 MIN = .01,K13MAX = 200,K14MIN = .01,K14MAX = 200 
AFGEN RL = 0,0, 1.-.03, 4, -.1,10, 0,16,0, 23, 0,29, 0,36,0,... 

42,0,48,0,54,0,61,0,67,0,80,0 

AFGEN YW= 0,0,1, .00006, 4, .006, 8, .04, 10, .07, 20, .29, 30, .55, 40, .8, 80, 1.61 
AFGEN SD = 0,0,1, -.004, 10, -.01 ,21 ,0,3 1 ,0,41 ,0,51 ,0,70,0,80,0 
INITIAL SEGMENT 

IF(FLAG.LT.O.) K1 = K01 
IF(FLAG.LT.O.) K2 = K20 
IF(FLAG.LT.O.) K3 = K30 
IF(FLAG.LT.O.) K4=K40 
IF(FLAG.LT.O.) K5=K50 
IF(FLAG,LT.O.) K6=K60 
IF(FLAG.LT.O.) K7=K70 
IF(FLAG.LT.O.) K8=K80 
IF(FLAG.LT.O.) K9=K90 
IF(FLAG.LT.O.) K10= K100 
IF(FLAG.LT.O.) K11 = K110 
IF(FLAG.LT.O.) K12=K120 
IF(FLAG.LT.O.) K13=K130 
IF(FLAG.LT.O.) K14=K140 
FLAG = FLAG +1 

IF((K1.LE.K1MIN).0R.(K1.GE.K1MAX)) THEN 



74 



K1 = KOI 
END IF 

IF((K2.LE.K2MIN).OR.(K2.GE.K2MAX)) THEN 
K2= K20 
END IF 

IF((K3.LE.K3MIN).OR.(K3.GE.K3MAX)) THEN 
K3= K30 
END IF 

IF((K4.LE.K4MIN).OR.(K4.GE.K4MAX)) THEN 
K4= K40 
END IF 

IF((K5.LE.K5MIN).OR.(K5.GE.K5MAX)) THEN 
K5= K50 
END IF 

IF((K6.LE.K6MIN).OR.(K6.GE.K6MAX)) THEN 
K6= K60 
END IF 

IF((K7.LE.K7MIN).OR.(K7.GE.K7MAX)) THEN 
K7=K70 
END IF 

IF((K8.LE.K8MIN).OR.(K8.GE.K8MAX)) THEN 
K8= K80 
END IF 

IF((K9.LE.K9MIN).OR.(K9.GE.K9MAX)) THEN 
K9= K90 
END IF 

IF((K10.LE.K10MIN).OR.(K10.GE.K10MAX)) THEN 
K10=K100 
END IF 

IF((K11.LE.K1 IMIN).OR.(Kl I.GE.K1 1MAX)) THEN 
K1 1 = KI 10 
END IF 

IF((K12.LE.K12MIN).OR.(K12.GE.K12MAX)) THEN 
K12= K120 
END IF 

IF((K13.LE.K13MIN).OR.(K13.GE.K13MAX)) THEN 
K13= K130 
ENDIF 

IF((K14.LE.K14MIN).OR.(K14.GE.K14MAX)) THEN 
K14= KI40 
ENDIF 
Cl(l)-1 
Dl(l)= 8.6 
Dl(2)= 1 
C2(l)= Kl 
C2(2)= K2 
C2(3)=K3 
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C2(4)= 1 
D2(l)= K4 
D2(2)= K5 
D2(3)=K6 
D2(4)= 1 
C3(l)= K7 
D3(l)= K8 
D3(2)=K9 
D3(3)= 1 
C4(l)= K10 
C4(2)= K 1 1 
C4(3)= 1 
D4(l)= K12 
D4(2)= K13 
D4(3)= K14 
D4(4)= 1 
C5( 1)= 1 
D5(l)= 11.4 
D5(2) = 1 
DERIVATIVE 

RIN = 0.0*STEP(0) 

YIN=3.*STEP(0) 

SIN = 0.*STEP(0) 

El = RIN-ROLL 

E2 = YIN-YAW 

E3= SIN-SPEED 

FIN1 = TRNFR(0,1,IC,C1,D1,E1) 

FIN2 = TRNFR(3,3,IC,C2,D2.KC1*E2) 

FIN= FIN1 + FIN2 

ROLL1 = TRNFR(0,2,IC,A1,B1,C11*FIN) 
RUDDER = YIN-YAW 

ROLL2= TRNFR(1,3.ICA2,B2,C12*RUDDER) 
ROLL= ROLL1 + ROLL2 
YAW = TRNFR(0,4,IC,A3,B3,C22*RUDDER) 
SP1 = TRNFR(0,2,IC,C3,D3,E1) 

SP2 = TRNFR(2,3,IC,C4,D4,KC3*E2) 

SP3 = TRNFR(0,1,IC,C5,D5,E3) 

SPEED1 = TRNFR(1,3,IC,A4,B4,C3I*FIN) 
SPEED2 = TRNFR(0,2,IC,A5.B5,C32 : *RUDDER) 
POWER = SP3-SP2-SP1 

SPEED3 = TRNFR(0,1,IC,A6,B6,C33 1 ‘POWER) 
SPEED = SPEED3-SPEED2-SPEED1 
X = TIME 

YNL1 = NLFGEN(RL,X) 

YNL2 = NLFGEN(YW,X) 

YNL3 = NLFGEN(SD,X) 

EE1 =((ROLL-YNLl)**2) 
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El 1 = INTGRL(IC,EE1) 

EE2 = ((YAW-YNL2)**2) 

E22= INTGRL(IC,EE2) 

EE3 = ((SPEED- YNL3)**2) 

E33 = INTGRL(IC,EE3) 

E=E11 + E22 + E33 
CONTROL FINTIM = 50.DELT = .01 
TERMINAL 

ER = E 

END 

STOP 

FORTRAN 

IMPLICIT REAL*8(A-H,0-Z) 

DIMENSION X( 14),STEP( 14), Q( 14),QQ( 14), W( 14) 

STEP(1) = 4. 

STEP(2)= .001 
STEP(3) = 2. 

STEP(4) = 4. 

STEP(5)= 2. 

STEP(6)= 1. 

STEP(7) = 0.005 
STEP(8) = 1. 

STEP(9) = 0. 1 
STEP(10)= 15. 

STEP(11) = .005 
STEP(12)= 7. 

STEP(13) = 5. 

STEP(14) = 2. 

N= 14 

ITMAX = 200 
CFTOL=. 0000001 
ALPHA =2 
BETA = .5 
IPRINT = 0 
MINMAX = -1 

CALL HOOKE(X, STEP, N,ITM AX, CFTOL,ALPHA, BETA, 
*CF,Q,QQ,W,IPRINT,M INMAX) 

STOP 

END 
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APPENDIX H 

COMPUTER PROGRAM FOR COMPARISON BETWEEN ROBERTS 

AND F.M. 



TITLE SIMULATION FOR COMPARISON BETWEEN ROBERTS AND F.M. 
***** ROBERTS OUTPUT ***** 

ARRAY A1(1),B1(3),A2(2),B2(4),A3(1),B3(5),A4(2),B4(4),... 
A5(1),B5(3),A6(1),B6(2) 

ARRAY Cl( 1),D1(2),C2(4),D2(4),C3(1),D3(3),C4(3),D4(4),C5(1),D5(2) 

TABLE Al(l)= l,Bl(l-3)=4,.24,l,A2(l-2)= -8.57, l,B2(l-4)= 53.3,17.17,... 
9.52,1.A3(1)= 1 ,B3( 1-5) = 12,32.25,1 1.2, 1,0, A4(l-2)= 10,1,... 

B4(l-4) = 240,58,26,1,A5(1)= l,B5(l-3) = 240, 34,1, A6(l)= 1,... 

B6( 1-2) =24,1 

TABLE Cl(l)= l,Dl(l-2) = 8.6,1, C2( 1-4)= -34. 14, 2, -8.3,1,... 

D2(l-4)= 53. 2.17.13, 9.5, 1,C3(1)= l,D3(l-3)= 14.8,1.3,1,... 

C4(l-3) = 2000,-2.1,D4(l-4)= 130,25,12.6,1,... 

C5(l)= l,D5(l-2)= 11.4,1 

CONST Kll = 0.114,K12 = 0.18,K22 = .01,K31 = 0.058, K32 = 0.096, K33 = 0.1,... 

RL = 0.,YW = 0.,SP = 0. 

CONST KC1 = - 1.6, KC2 = 0.579, KC3 = 0.0456,... 

GC 10 = 0,GC20 = 0.GC30 = 0.GC40 = 0,GC50 = 0 
DERIVATIVE 

RIN = 0.Q*STEP(0) 

YIN = 3.*STEP(0) 

SIN = 0.*STEP(0) 

El = RIN-ROLL 
E2 = YIN-YAW 
E3 = SIN-SPEED 

FIN1 = TRNFR(0,1.GC10,C1,D1,E1) 

FIN2 = TRNFR(3,3,GC20,C2,D2.KC1*E2) 

FIN= FIN1 -r FIN2 

ROLL1 = TRNFR(0,2,RL,A1,B1,K 1 1 *FIN) 

RUDDER = YIN- YAW 

ROLL2 = TRNFR(1,3,RL,A2,B2,K12*RUDDER) 

ROLL= ROLL1 + ROLL2 

YAW = TRNFR(0,4,YW,A3,B3,K22*RUDDER) 

SP1 = TRNFR(0,2,GC30,C3,D3,KC2*E1) 

SP2 = TRNFR(2,3,GC40,C4,D4,KC3*E2) 

SP3 = TRNFR(0, 1 ,GC50,C5,D5,E3) 

SPEED 1 = TRNFR(1,3,SP,A4,B4,K31*FIN) 

SPEED2 = TRNFR(0,2,SP,A5,B5,K32*RUDDER) 

POWER= SP3-SP2-SP1 

SPEED3 = TRNFR(0,1,SP,A6,B6,K33*POWER) 

SPEED = SPEED3-SPEED2-SPEED1 
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***** FUNCTION MINIMIZATION OUTPUT ***** 

ARRAY AA1(1),BB1(3),AA2(2),BB2(4),AA3(1),BB3(5),AA4(2),BB4(4),... 

AA5(1),BB5(3),AA6(1),BB6(2) 

ARRAY CC1(1),DD1(2),CC2(4),DD2(4),CC3(1),DD3(3) 

ARRAY CC4(3),DD4(4),CC5( 1),DD5(2) 

TABLE AA1(1)= l,BBl(l-3)= 4,.24,l,AA2(l-2) = -8.57,1, ... 

BB2(l-4)= 53.3,17.17,9.52,1,... 

AA3(1)= l,BB3(l-5) = 12,32.25,1 1.2,1, 0,AA4(l-2) = 10,1,... 

BB4(l-4)= 240,58,26,1,AA5(1) = l,BB5(l-3)= 240, 34,1, AA6(1) = 1,... 

BB6( 1-2) =24,1 

TABLE CC1(1)= 1,DD 1(1-2)= 8. 6, 1,CC2( 1-4) = -72. 14,1.98925,-2.3,1,... 

DD2(l-4) = 76.2,28.63,1 1.5.1,DD3( 1-3)= 32.05.2.975,1,... 

CC4(l-3)= 1741. 25, -1.94375.1, DD4(l-4)= 9.25, 11 1.25, 47. 1,1.... 

CC5(1)= l,DD5(l-2)= 11.4, 1,CC3(1)=. 63525 
CONST KK1 1 = 0.1 14, KK12 = 0. 18, KK22=. 01, KK31 = 0.058, KK32 = 0.096, KK33 = 0. 

RRL = 0.,YYW= 0.,SSP = 0.,KKC1 = -1.6,KKC3 = 0.0456 
CONST GGC10 = 0,GGC20 = 0,GGC30 = 0,GGC40 = 0,GGC50 = 0 
DERIVATIVE 

RRIN = 0.0*STEP(0) 

YYIN=3.*STEP(0) 

SSIN = 0.*STEP(0) 

EE1 = RRIN-RROLL 
EE2 = YYIN-YYAW 
EE3 = SSIN-SSPEED 

FFIN1 = TRNFR(0,1,GGC10,CC1,DD1,EE1) 

FFIN2 = TRNFR(3,3,GGC20,CC2,DD2,KKC1*EE2) 

FFIN = FFIN1 + FFIN2 

RROLL1 = TRNFR(0,2,RRL,AA1,BB1,KK1 1*FFIN) 

RRUDDE = YYIN-YYAW 

RROLL2 = TRNFR(l,3,RRL,AA2,BB2,KK12*RRUDDE) 

RROLL= RROLL1 + RROLL2 

YYAW = TRNFR(0,4,YYWAA3,BB3,KK22*RRUDDE) 

SSP1 = TRNFR(0,2.GGC30,CC3,DD3,EEi) 

SSP2 = TRNFR(2,3,GGC40,CC4,DD4.KKC3*EE2) 

SSP3 = TRNFR(0,1,GGC50,CC5,DD5,EE3) 

SSPEE1 = TRNFR(1,3,SSP^A4,BB4,KK31*FFIN) 

SSPEE2 = TRNFR(0,2,SSP,AA5,BB5,KK32*RRUDDE) 

PPOWER= SSP3-SSP2-SSP1 

SSPEE3 = TRNFR(0,1,SSP,AA6,BB6,KK33*PPOWER) 

SSPEED= SSPEE3-SSPEE2-SSPEE1 
CONTROL FINTIM = 80. 

*RINT l.,FFIN,RRUDDER,RROLL,YYAW,SSPEED 
SAVE (SI) 0.1, ROLL, RROLL, YAW, YYAW, SPEED, SSPEED 
GRAPH(G1/S1,DE = TEK618,PO = 0,.5) TIME(LE = 8., UN = SEC) YAW(LO = -2,LI 
SC = .5,NI = 8),YYAW(LO= -2, LI = 4, SC = .5,NI = 8) 
LABEL(Gl)COMPARISON BETWEEN ROBERT AND F.M 
LABEL(Gl)FOR YAW OUTPUT 
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GRAPH(G2/S1,DE = TEK618,PO = 0,.5) TIME(LE = 8.,UN = SEC) ROLL(LO= -2, LI = l 

SC = ,5,NI = 8),RR0LL(L0 = -2, LI = 4, SC = .5,NI = 8) 

LABEL(G2)C0MPARIS0N BETWEEN ROBERT AND F.M 
LA3EL(G2)FOR ROLL OUTPUT 

GRAPH(G3/Sl,DE = TEK618,PO = 0,.5) TIME(LE= 8.,UN= SEC) SPEED(LO= -2, LI = 1,... 

SC = .5, NI = 8),SSPEED(LO = -2.LI = 4, SC = .5,NT = 8) 

LABEL(G3)COMPARISON BETWEEN ROBERT AND F.M 

LABEL(G3)FOR SPEED OUTPUT 

END 

STOP 
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